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Abstract 



Using tools and techniques from geometric control theory, namely Hermann- 
Nagano theorem, we prove controllability result for a mechanical system con- 
sisting of a planar double inverted pendulum fixed to a wheeled cart that can 
\^ , move linearly along a horizontal track. 
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1. Introduction 

JZ^ ' The inverted pendulum is a typical example of nonlinear control system 

-^ , which is intensively studied. The problem of controllability and stabilization 

ly^ ' of inverted pendulum on a cart has been addressed by several authors using 

Tlj" , different strategies. A series of papers ([2j_3, |8|) has been published on energy 

^^ ' strategies. More recently. Mason et al in 7| obtained qualitative results on the 

(^ , global structure of the time optimal trajectories of the planar pendulum on a 

CN ' cart. 

The present paper aims at a different target: verifying controllability of the 
(non-linear) mechanical system by application of tools from geometric control 
theory. 

The paper is organized as follows. After the Introduction, in the second 
C^ , section we describe the mechanical system consisting in two linked planar in- 

verted pendulums on a cart (PIDP) and deduce the equations of the dynamics. 
The third section recalls some definitions and results from geometrical control 
theory. In the next section several results are proved in particular the main 
result which establishes the controllability of PIDP. The proof of controllability 
is mainly based on the existence of a bracket-generating family of vector fields 
for PIDP which the Lie algebra has constant dimension over each orbit of the 
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family through a point. The last section contains some remarks on the choice of 
the bracket-generating family used and on some particular mechanical systems 
which controllability could not be proved. 



2. Inverted double pendulum on a cart 

We consider a mechanical system which is a double mathematical inverted 
pendulums (i.e. a double pendulum in a gravitational field without friction and 
tension). Each pendulum is modeled by a mass point (the bob of mass mi) and 
a massless beam of length r^ . The second pendulum is attached to the bob of 
the first one. We neglect the axial rotation of the beams, so there is one degree 
of freedom for each pendulum. The pivot of the first pendulum is fixed to a 
wheeled cart that can move linearly along a horizontal track. 

We assume that controlled acceleration u(-) is applied to move the cart in 
horizontally direction in order to balance the two linked inverted pendulums 
on the cart. Therefore the motion occurs in the vertical plane. Consider a 
coordinate system with the origin at the pivot of the first pendulum. For i € 
{1,2} let 9i be the angle between each pendulum and the positive part of vertical 
axis at time t, i.e. 9i = 9i{t) with 9i : [0,oo[ — > [— tt, 7r[;i e {1,2}. On each 
mass there is an actuating force resulting from the acceleration u. Letting 
9{-) ~ (^i(')i ^2('))i the system's kinetic energy is given by 



1 



1 



T{9, 0,t)^- (mi + ma) rf 9t + m^ n ^2 9i 02 cos{9i -82) + ^ m^ r^ 9^ 

while the potential energy is U{9, t) ~ g [{mi + 7712) ri cos^i + 7712 ?'2 cos 02]- 

Using Euler-Lagrange equations, we obtain the dynamical equations. Since 
the system is conservative, we get 

dL d dL , ^ ^ ^ 

where L = L{9,9,t) = T{9,9,t) - U{9,t) and u : [0,oo[ — > R is the control. 
This is a system of second order ordinary differential equations in 9i;i G {1,2}. 
Introducing the notation ri r2[mi + m2 sm^{9i — ^2)] = A(^) > 0, ^^ = w^; i G 
{1,2} and z — (^i, ^2, wi, ^2)^, the system can be rewritten as a system of first 
order differential equations 



i = /(z) + /i(z)u(i), 



where 
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92 cos{9i - 92) 
- 7712) [cos(0i — I 



{mi + 7712) sin I 
) sin^i — sin02] 
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A{9) 
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-m2 72 [71 cos(6'i - 92) ujf + r2 w|] 
\ri [ri {mi + m2) w^ + 72 m2 cos(0i - ^2) w|] / 



and 
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h{z) 
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^2 [ri m2 cos(6'i - 6*2) - r2 mi] 
\ri [r2 mi cos(0i - 62) - ri (mi + m,2)]y 



For simplicity, we use the following notation 



A(0)/(z) 



^^2(2) 

ai{z) 

\a2iz) J 



A{9)h{z) 
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d^, (5) 



n{z) = 



r!i(z) 
r!2(z) 



a{z) = 



ai(z) 
02(2) 



6(0) = 



h2{0) 



(6) 



f^(6') - -A{9)b{9), 



a^{z) = n^{z) de b ~ b^{9) d^ a, 



and 



F(0) = 6^(0) [2A(0) 9e b - d^{b^{9) 8^ a)] 



(7) 



(8) 



where the superscript T stands for transposition and O2 is the zero two dimen- 
sional vector. We assume that mechanical system parameters satisfy 



mi 



ri (ri ± r2) 



m2 r| - ri (ri ± r2) 



and 



^ ^ ^. (9) 
m,2 rf 



To study controllability of system ©-([5]) we will use some techniques from 
geometric control theory for systems with recurrent drift. Next section collects 
some definitions as well as some classical results. 



3. Classical results from geometric control theory 

Let y be a smooth manifold and Vec V the set of all smooth vector fields on 
V. Let X 6 Vec F be a complete vector field. A point p € V is called Poisson 
stable for X if for any t > and any neighbourhood U oi p there exists a point 
q ^ U and a time t' > t such that q o Pf, e U, where Pt is the flow generated 
by X. Poisson stability is associated with the vector field defining the system. 
According to Poisson stability all trajectories cannot leave a neighbourhood of 
a Poisson stable point forever, some of them must return to this neighbourhood 
for arbitrarily large times. Note that, if a trajectory po Pf is periodic, then p is 
Poisson stable for vector field X. A complete vector field X G Vec V is Poisson 
stable if all points of V are Poisson stable for X. Next theorem characterizes 
such sets see [3|, |6| . 



Theorem 1. Let V be a smooth manifold with a volume form Vol. Let a vector 
field X G Vec V be com,plete and its flow Pt preserve volume. Let W <Z V,W G 
intP^, be a subset of finite volume, invariant for X : 

Vol(Ty) < oo, WoPtCW, t>0. 

Then all points of W are Poisson stable for X. 

Let 

T={Xi,...,Xk}cYecV 

be a family of complete differentiable vector fields defined on the manifold V. 
The Lie algebra generated by T is defined by 

Lie(J-)==span{[Xi,[...[Xfe_i,Xfe]...]] : k eN, X^, . . . ,Xk e T,}, 

where [•, •] stands for Lie bracket. 

For any p G V, we denote by Liep(7^) the set of all tangent vectors po X to 
V with X G Lie (T) 

Uep{T) ^{po X : X eUe (J")} cTpV 

where Tp V is the tangent space to V at p. 

The orbit of the family T through a point p E V is the set 

Op{T) = {p o 6*1-^1 o • • • o e*'-^' : ieN,ti,...,t,eR,Xi,...,X,eT}, 

where e*^^^ is the flow generated by vector field Xj, i.e. Op{J-') is the set 
of all attainable points from p composing flows generated by vector fields in J-". 
Therefore, in an orbit Op{T), one is allowed to move along vector fields Xj both 
forward and backwards (with reverse time). If only forward motion is permitted 
the set obtained is called attainable set 

Ap{J^) = {poe*i^i o---oe*'^' : i eN,ti, . . . ,t, > 0,Xi, . . . ,X, e T}. 



For analytic manifolds, the following result, known as Hermann-Nagano the- 
orem, holds (see [5| for further information). 

Theorem 2. Let V be an analytic manifold and T a family of analytic vector 
fields on V . Then 

(a) each orbit of J- is an analytic submanifold of V , and 

(b) if Op{T) is an orbit of J- through p g V, the tangent space of Op{J-) at 
q is given by Lie^ {J-') . In particular, the dimension of Lie^ {J-) is constant 
as q varies over Op{J-). 



It remains to introduce two definitions in order to state the results which 
will allow us to prove controllability of system ([2]) -([9]). 
A family T C Vec V is called bracket-generating if 

Liep(J") = rpT/, Vpey 

and a vector field X e Vec V is called compatible with a family T C Vec V if 



^p(-FU{X})c^p(-F), pel/. 
For the proof of the following results see [1| . 

Proposition 1. Lei T d VecV he a bracket- generating family. If a vector field 
X E T is Poisson stable, then the vector field —X is compatible with T . 



Proposition 2. If J- C Vec V is a bracket- generating family such that the 
positive convex cone generated by J-' 



cone 



iJ') = {j2 °'^^ ■■keN,Xi,...,XkeT,ai,...,akeC°^iV),a,>o\ cYecV 



is symmetric, then T is controllable, i.e. Ap{T) = V . 

The set cone(J^) being symmetric means that if y e cone(J^) then —Y G 
cone(J^). 

4. Controllability analysis 

By means of Legendre transform, we convert Lagrangian system ([T]) into the 
Hamiltonian system 

89., dpi 

where H(9,p,t) — p9 — L{9,9,t); this is a fourth dimensional (symmetric) 
system. Hamiltonian system state space is then [0,7r[ x[0,7r[ xK^. 

For uncontrolled system, i.e. when u{t) = for all i > 0, Hamiltonian 
function is constant since it does not depend explicitly on time. On state space, 
solutions {9,p) to Hamiltonian system are such that H{9,p) = c, for different 
values of c G M depending on initial conditions. These solutions remain on the 
compact defined by iJ < c+l. From Liouville theorem, the Hamiltonian system 
phase flow preserves volume and therefore, according to Theorem [TJ the vector 
field associated with this fiow is Poisson stable. Since the map $ : {9, 9) — > 
{9,p) is a diffeomorphism and trajectories {9,p) are Poisson stable on phase 
space, trajectories {9, 9) on state space are Poisson stable. 



Let N be the set H{9,p) = c, for different values of c £ M, which is invariant 
under Hamiltonian dynamic and M = ^~^{N); then M is invariant under 
Lagrangian dynamic. 

Two vector fields arise naturally associated with system ([2]), 

f{z)d, and h{z)u{t)d,. (10) 

On state space, the dynamic of uncontrolled system is governed by vector field 
fd^. We saw that trajectories {9, 9) on state space are Poisson stable, therefore 
vector field fdz is Poisson stable. 
Let 

^={Xi,X2,X3,X4} (11) 

where Xi,X2,Xz,Xi are vector fields obtained from vector fields in P^ and 
their Lie brackets 



Xi = A{9) f{z)d, = n^{z)dg + a^{z)d^, X2 = A{9) h{z)d, = b^{9)d^, 

(12) 



X, = [x,,X2] = n'^{9)dg + a^i9)^d^, X, = [X2,x,] = 6''(e)§5. 



Here the notation follows (O-®. 

Theorem 3. If J- defined in (jlip - (|12p is a bracket- generating family of vector 
fields, then Ap{T) = Op(F), for all p e M . 



Proof. Using vector fields in T we can obtain vector fields f{z)dz and h[z)u{t)dz 
Since u{-) is a scalar function both h{z)\u{t)\dz and —h{z)\u{t)\dz belong to F. 
Moreover, since f{z)dz is Poisson stable, Proposition [T] ensures that —f{z)dz is 
compatible with T. Therefore, for all p e M, Ap{J-) = Op{J-). D 

Corollary 1. Under conditions stated in Theorem\3^ system ([2])-® is control- 
lable. 

Proof. If Theorem |3] holds, the cone 
cone(^) = J ^a,X, : fc e N, Xi, . . . ,Xfc e ^, ai, . . . ,afe G C^{V),a, > 0, \ 

is symmetric and Proposition [2] establishes that the system is controllable. D 

Previous results assumed family J^ defined in pT|) -([T ^ to be bracket gener- 
ating. The proof that family T is bracket generating implies studying several 
subsets of manifold M defined by means of analytic equations. Although the 
proof is not hard it is laborious. Main argument in the proof is that Liep(J^) 
has constant dimension for all p in some orbit of J'. Some details of the proof 
are omitted since only simple computations were involved. 



Lemma 1. The family of vector fields T defined in (|lip - (jl'2p is bracket-generating, 



I.e. 



UepiJ^) = TpM, ypeM 



Proof. Let F be the subset of M on which vector fields X2 and X4 are hnearly 
dependent and T the subset of M on which vector fields Xi and X^ are linearly 
dependent on the direction de- We denote by 

M = M\(r U T) 

the subset of M on which vector fields defined in (IT^ are linearly independent. 
Then, for all peM, 

dimLiep(J^) = 4. 

Subsets r and T are not J- invariant, i.e. an orbit of J- always leaves this sets. 
In fact, although X2 and X4 are linearly dependent over T using X2 and X3 it 
is possible to leave T through an orbit of J-. Let X2 and X3 denote the vector 
components for X2 and X3, respectively, 



X2 



( \ ( A{B)bm\ 



V b2{6) j 



3^3 



A(0) 62(e) 
* 



Since b\{ff) and 62(e) are not simultaneously zero, we get that X2 and x^ are not 
collinear. 

Analogous situation occurs for T, but now it is required to use also vector 
field X4 in order to leave T. To prove it, three main steps are needed. First we 
define a region S^ and we solve equation Xi ■ Sk — 0. This last equation defines 
a set Sk+i C Sk which is invariant by Xi. 

Let E be the subset of M on which vector fields Xi , X3 are linearly depen- 
dent on the direction d^j and ^2,^4 are linearly dependent (on direction de); 
S is the intersection F and T. Here vector fields X2 and X3 are linearly inde- 
pendent. Therefore S has dimension two. 

Let qq be a point in the orbit Op{T) through a point p G M. We study four 
different situations. 

First assume that qo E 'S. Then, as it was seen earlier, the orbit Op(J-') 
leaves E. When Oq„(J") leaves S either it enters M, T \ E or F \ S. 

Now, assume that go G M. In M all vector fields in J^ are linearly inde- 
pendent. An orbit of the family T through qo G M is, then, generated by four 
vector fields and Oqg (J-) has dimension four. Therefore, the dimension of the 
tangent space to the orbit at any z S Oqg (T) , T^ Oq„ {T) , has dimension four. 
Moreover, by Hermann-Nagano theorem, for all z e Oq„{T), 

Tz Oq„ (T) = Lic^ ( J") , and dim Lie^ J" = 4. 



Since for z E M, the tangent space T^M has dimension four we conclude that 

T^JI = Ue^^iT), for z eM. 

Third situation occurs when qo E {T \ E). The orbit Op{F) leaves T \ E. 
Recall that in M the Lie algebra generated by iF and evaluated at any z E M, 
IABz J^i has dimension four and such dimension is constant for z € M. If O^^ {F) 
leaves T to M, then for z G T\S the tangent space to the orbit Op{F) must have 
dimension four: A\v[\TzOqa{F) = 4. And, once again, from Hermann-Nagano 
theorem 

dimLie^(J') =4, z e (T \ S). 

This means that there must be four Lie brackets of vector fields in J- that span 
Liej J^, z e (T \ E). On the other hand, the orbit Oqg{IF) only leaves T \ E to 
r on the intersection of the two regions, that is, on E. But this is the first case 
studied. 

At last, let us assume that go G (L \ E). The orbit Oq„{T) leaves F \ E. 
If Ogo [F) visits M, by analogy with the second situation studied, there exist 
some Lie brackets spanning Liez(-F), z G (F \ E). On the other hand, the case 
when Oqa (T) visits T \ E is the third case. 

Finally, we conclude that for z G M, TzM — Lie^ F , i.e. family F is 
bracket-generating in M . D 

5. Concluding remarks 

In this paper we considered a mechanical system consisting in two linked 
planar inverted pendulums on a cart. The main result obtained is the proof 
of existence of a bracket-generating family of vector fields F for which the Lie 
algebra has constant dimension over each orbit of the family through a point. 
In the proof of Lemma [T] it is necessary to guarantee © . If equality holds in 
^ it is not possible to prove that the orbit of family F leaves E and therefore 
to prove that F is bracket-generating. 



As vector fields X2 and X4 in (|T2t only have non zero components in two 
directions, d^, it seams natural to look for two other vector fields with non zero 
components only in directions Oq. For the subset of M where X2, ^4 are linearly 
independent these vector fields form a basis for directions 3aj. Therefore, it is 
possible to span new vector fields, say li and is, which components associated 
to directions duj are zero 

Yi=Xi- (72(z) X2 + 1a{z) X4), 72, 74 e M 

^^3 = ^3 - {l2{z) X2 + idz) Xi), 72, 74 e M. 

That is, new vector fields are such that Yi = V,'^{z)dg and Y3 = Cf"{9)dg given 
that (jl3|) does not alters components on directions dg. This way, we could had 



chosen to work with another family of vector fields, say 

Since vector fields in Q result from linear combinations of vector field in J-, this 
new family is also bracket generating family for system ^. Yet, vector fields 
in Q are not defined for all points in M so it would be necessary to use other 
vector fields to study F. 
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